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ABSTRACT 


Kalman filtering techniques are applied to a two sensor bearings only passive 
target motion analvsis problem. An algorithm 1s developed to simulate tracking long 
range maneuvering airborne targets. The target tracking performance of the filter is 
evaluated using computer generated noisy bearing measurements. The performance of 


the filter is satisfactory given reasonable initial conditions and measurement noise. 


THESIS DISCLAIMER 


The reader is cautioned that computer programs developed in this research may 
not have been exercised for all cases of interest. While every effort has been made, 
within the time available, to ensure that the programs are free of computational and 
logic errors, they cannot be considered validated. Any application of these programs 


without additional verification is at the risk of the user. 
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I. INTRODUCTION 


Aur defense of a carrier battle group is becoming significantly more complex due 
not only to the increased speed and range of potentially hostile aircraft but also to 
more capable enemy targeting systems and greater cruise missile ranges. To reduce the 
probability of an aircraft carrier being successfully targeted by an enemy cruise missile 
Carrving aircraft, it 1s imperative that fighter intercept be accomplished bevond the 
maximum range of the cruise missile. Long range over-the-horizon (OTH) target 
detection and tracking are necessary to achieve this goal. 

A major obstacle common to all air defense scenarios is the enemy's use of 
electronic countermeasures (ECM). Attacking enemv aircraft will undoubtedly employ 
jareming as well as other forms of ECM to degrade or deny effective tracking by active 
systems. Therefore, the ability to passively track is required in order to successfully 
engage attacking aircraft in a dense ECM environment. 

One viable approach to this problem is passive Target Motion Analysis (TMA). 
The purpose of TMA 1s to determine the target’s position, course and speed through a 
series of passive noisy measurements. For the air defense scenario, these passive 
measurements may be lines of bearing (LOB) obtained from the enemy aiurcraft’s 
jamming strobes or from the electromagnetic radiation of the aircraft's long range 
targeting radar. 

Passive bearings only TMA may be performed by one or more sensors. The two 
primary considerations in evaluating TMA performance are solution accuracy and 
timeliness. Single sensor TMA requires that the observer aircraft perform zig zag 


maneuvers to establish a target bearing rate so that the range to the target may be 





estimated. One drawback to single sensor TMA is the fact that these maneuvers may 
detract from the observer aircraft's primary mussion. Also. a reasonable initial estimate 
of ine target's stale (position, course alu speed) is Mecessary lo ensure Lhal Wie Wacaing 
solution converges in a timely manner, if indeed it converges at all. An inherent 
difficulty with bearings only TMA by a single sensor is that the solution accuracy and 


timeliness rely quite heavily upon a “good” a priori estimate of target range. 





te ce 
te 


Consecuentl) vim a long range tracking scenario where the range to the target may 


ee 


exceed sev eral hundred miles, accurate tracking by a single sensor using only bearing 


observ ations is extremely arduous and rather impractical. 


ene — 


A practical solution to long range OTH passive tracking is ‘multi-sensor. 
triangulation. High speed air targets can be accurately tracked by two or more highly 
directional sensors that are spaced sufficiently far apart. The primary reason that multi- 
sensor tracking is superior to single sensor TMA is that estimates of target range are 
continually being generated through triangulation of sensor bearing lines. Multi-sensor 
tracking for timely convergence. The major obstacle, however, in using the multi-sensor 
triangulation method is a practical one: very close cooperation is required between the 
observers in order to achieve an accurate tracking solution. Three ingredients are 
required to localize a target: the position of each sensor, the time of the observation, 
and the bearing measurement from each sensor. Ideally, all observations would be 
performed synchronously. If asynchronous lines of bearing are encountered, then 
computer processing 1s required to interpolate these LOB’s to produce “synchronous” 
measurements. The observers are, in effect, remote sensors that transmit noisy bearing 
data to a central processing platform where the actual target tracking is performed. For 
tracking a long range and rapidly closing air target, triangulation provides a 
significantly more accurate and tumely tracking solution. e 

Because each sensor generates its own sequence of noisy bearing observations, 
the Kalman filter is ideally suited for determining a target’s position and motion. This 
thesis investigates the two sensor bearings only tracking problem in a computer 
simulation that emplovs Kalman filtering techniques. The simulation generates the 
target and observer tracks as Well as noisv bearing measurements from each sensor to 
the target. The noisy bearings are then processed by the Kalman filter to provide 
continual estimates of the target’s state. The tracking algorithm 1s used in several 
scenarios to determine the effect various sensor bearing accuracies and initial estimates 
have on the filter’s performance. 

The aim of this research is to examine how well the filter performs in tracking a 
non-maneuvering target before investigating the more difficult case of a maneuvering 
lurget. The probiem geometry will be presented first, followed oy the deveiopment o1 
the svstem and measurement models. Relevant equations from Kalman filtering theory 
will then be briefly reviewed before the actual tracking algorithm ts analyzed in detail. 
The results of several simulation runs using various parameters will be examined. Also, 
the effect of target maneuvers on filter stability will be assessed. The final chapter will 
summarize the results of this research and will present conclusions and 


recommendations for further study. 
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II. PROBLEM DESCRIPTION 


A. INTRODUCTION 

As the name implies, over-the-horizon detection and tracking means positioning 
sensors out near the radar horizon to look over the edge and pass their observations 
back to a central data fusion point for analysis. This data fusion point need not be a 
surface combatant; it could be a command and control aircraft. The use of an airborne 
command and control platform extends the range to which an air target can be 
effectively tracked. The basic idea behind OTH tracking is to place the remote sensors 
far enough apart so that effective triangulation fixes may be taken but not so far apart 
iat ies ealemoc OuGetne Trance: at “hich they can communicate with the central 
processing platform. The command and control aircraft snould ideally be positioned on 
the threat axis between the incoming air attack and the high value umit (HVU) that is 
being protected. Figure 2.1 depicts the general geometry of a basic OTH detection and 
tracking scenario. 





or 


REmoTE sensor \ 
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Figure 2.1 Basic Over-the-Horizon Detection and Tracking Scenario. 


In this chapter the geometry of the two sensor TMA problem will be presented 


along with a development of the target motion and noise-free measurement equations. 
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B. PROBLEM GEOMETRY 
Consider the target-observer geometry in the two dimensional plane as shown in 
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Figure 2.2. Target-Observer Geometry. 


Figure 2.2. The target is located at (xp , ¥7) from a defined reference position. The 
origin may be defined as either a fixed latitude/longitude coordinate or the position of 
a high value unit such as an aircraft carner (whose position is relatively stationary). 
The x and y components of target velocity are denoted as XT and YT and are the 
Cartesian equivalents of the target's course and speed, Cy and Vy. Sensor I 1s located 
at (x, , 0) and is only able to move along the x-axis with velocity Xr. Likewise, sensor 2 


is located at (0 , y,) and is only able to move along the y-axis with velocity y,. As 


sensor 2 to the target 1s 0,. The ranges to the target from sensors | and 2 are denoted 
as r, and r, respectively, and the range of the target from the origin is denoted Rr. 
|. Problem Assumptions 
The following assumptions are made concerning the problem: 
1. The target is initially inbound and remains within the first quadrant. 


2. The target maintains a constant speed but 1s free to change course. 
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Both sensor positions are known precisely. 


4. Bearing data from each sensor are continuously observed and are received 
synchronously. 


5. Bearing noise is zero mean and Gaussian with variances She and os for sensors 
1 and 2, respectively. 


6. Target turns are modeled as instantaneous (1.e., no turn radius). 
7. Target and sensor altitudes have negligible effect at long ranges. 
The last assumption is entirely reasonable since the difference between the target’s 
slant range and two dimensional range is less than a fraction of 1% for ranges 
exceeding 300 nautical miles. 
2. Practical Geometrical Considerations 

Placing the airborne sensors on orthogonal axes is chosen not only because it 
simplifies the geometrv but also because it provides adequate sensor separation with 
which to perform accurate triangulation. Ideally, the most accurate triangulation fix is 
formed from the intersection of two perpendicular lines of bearing. Perpendicular 
LOB’s in real world scenarios, however, are extremely difficult to obtain for a number 
of reasons. One reason is that the maximum range and on station time for airborne 
sensors are limited. Also, if electromagnetic energy from the target is being used to 
obtain LOB’s, it is important that both sensors be positioned within the main sector 
beam pattern. Figure 2.3 illustrates some of these considerations. In Figure 2.3 (a), it 
can be seen that in the attempt to obtain perpendicular LOB’s to the target, sensor 1 1s 
bevond the radar horizon of the command and control aircraft and is thus unable to 
pass anv bearing observations. Figure 2.3 (b) shows both sensors lying within the 
sector scan limits of the target's surveillance radar. While it is not necessarv for both 
sensors to be within the main beam simultaneously, both must be able to detect the 
beam’s presence within a reasonable time period, a factor which depends on the radar’s 
Scamurace. 

The scenario where the sensors are positioned on orthogonal axes could easily 
be moc:fied to the more general case where the sensors are iocated on radials that are 
eta cyoa O. 00 desrees, "Simce the sensors are now closer together, range 
estimates to the target would be somewhat degraded. Also, by adding a third sensor on 
a radial 120 degrees from the first sensor and 60 degrees from the second would 
provide a wider sector coverage as Well as improved tracking accuracy. 

The simulations that have been run in this thesis involve extreme ranges from 


each sensor to the target. It has been assumed throughout that the target and sensor 
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Figure 2.5 Practical Geometric Considerations. 


aircraft are flying at medium to high altitudes so that all observations will meet radar 
horizon range constraints. It should be noted, however, that the practical limiting 
factors for maximum detection range are the strength and radio frequency (RF) of the 
intercepted source signal. Also, bearing accuracies depend on the RF of the signal. 
Extreme detection ranges, sometimes between 400 and 500 nautical miles, have been 
used to represent a worst case tracking problem; shorter ranges would yield a more 


accurate tracking solution. 


C. — SYSTESEMIODEL 
As shown in Figure 2.2, lines of bearing from two airborne sensors are used to 
determine the target's state (position, course and speed). Using a Cartesian coordinate 


system, a four dimensional state vector, XT; is chosen. 


xg 
xy 


XT = me (eqn 2th 
¥v 


It should be noted that the svstem model is in no way limited to a Cartesian reference 
frame or state vector; the Cartesian coordinate svstem was chosen merely for its 


mathematical simplicity. 
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|. Target Maneuvers 
Two basic scenarios are addressed in this thesis. The first one involves 
tracking a non-maneuvering target and the second involves a maneuvering target. In 
both cases the target is assumed to be initially inbound and any target maneuver will 
consist of the target changing only its course and maintaining its speed. Figure 2.4 


shows the target tracks that will be examined in subsequent chapters. 
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Figure 2.4 Representative Target Tracks. 


It is assumed that target maneuvers can be modeled by using white random 
forcing functions. As shown in Figure 2.5, target maneuvers mav be thought of as 
acceleration along its course (radial acceleration) and acceleration perpendicular to its 
course (turn rate). Let the random variables 6. and Og denote the target's acceleration 
along its course and acceleration perpendicular to its course, respectively. Both 5. and 
Og denote random changes of the target and are assumed to be independent and zero 
mean with variances oe and Cg". Because of the extremely long ranges involved in the 
simulations, target maneuvers have been modeled as instantaneous changes o¢ position 
according to the time interval used. That is, the simulation enables the target to turn 
90° in two seconds. While it is acknowledged that this kind of turn rate is quite 
artificial, it is informative to see what effect such a drastic turn rate has on tracking 


performance and stability. The variances used in subsequent scenarios are: 


IS 


c.* = (300knots/sec)? (eqn 2.2) 


Vv 


64" = (45 deg’sec)* (eqn 2.3) 
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Figure 2.5 Geometry of Target Maneuvers. 


a. Equations of Notion 
Let T represent the time interval between observations. If k represents the 
k™ observation and t, the discrete time of the k™ observation. then T may be 


expressed as 
To Bete, (eqn 2.4) 


Referring to Figure 2.2 and Figure 2.5, target motion may be described by the 


difference equations: 


x(K+T)]  [xq(k) + T xp(k) + £,(5,, 59, k) 


x (kel) = xp(k+ 1D] x(k) + £,(5,, 59, k) 
ae yrk+1)| [ys(k) + T yp(k) + 6(6,, 8g, k)| (eqn 2.5) 
vr(k+ | (Kk + £,(6,, 59, k) 


The random forcing functions f, through f, are included to account for random 
changes in speed and heading which occur for a moving target. Equation 2.5 may be 
written in matrix form as 


17T0 0 xx{k)} {77/2 0 
CTT o X7(k) te 0 x7(k) 
x(k+1)= [00 1 T] fyqtk)} [0  T7/21 Jyq(k)} (eqn 2.6) 
OF 0 O04 yk) 0 i 
L =! 
Or more concisely as 
Kee Pix, + Tewe (eqn 2.7) 
where Xj 1s the 4 X 1 state vector 


@, is the 4 X 4state transition matnx 
W, is the 2 x | vector of random forcing functions 


I. is the 4X 2 state forcing matrix. 


The terms of the random forcing function vector w, represent the 
accelerations in the x and v directions caused bv target maneuvers. The state forcing 
matrix I) represents a uniform constant acceleration model of target motion. If the 
time interval T between measurements is assumed constant, then ®, may be replaced 
by a constant state transition matrix ® and Tr, mav be replaced by a constant state 


forcing matrix [. Revising Equation 2.7, the linear system model can be expressed as 
Xp 4 ] = @ X, 7 Iw, (eqn 2.8) 


D. NOISE-FREE MEASUREMENT EQUATION 
As illustrated in Figure 2.2. the positions of sensors 1 and 2 along with their 
respective bearings to the target. 0, and 0, uniquely define the target's position (X7, 


Y7). The target's position from noise-free bearing observations may be expressed as 


iSarcos Oye x, Sin 9, ) sin 9, 
a) (eqn 2.9) 


_ (x; cos 8, — y, sin 8,) sin 6, 
os cos(8, + 85) (eqn 2.10) 


The positions and speeds for the airborne sensors may be chosen arbitrarily for 
input into the tracking algorithm. Each sensor’s position is assumed to be known 
precisely for each time interval. The sensors may both head inbound or outbound or 
they may go in alternate directions. Care must be exercised in choosing sensor 
positions and speeds so as to avoid having lines of bearing that are collinear (each 
sensor is pointing at the other). What results in this case is an extremely thin and 
elongated error ellipse which momentarily degrades tracking accuracy at the moment 
that the lines of bearing are coincident. 

It should be noted that using two sensors eliminates the need for anv extraneous 
observer maneuvering as is the case for a single sensor. The observer aircraft can 
basically fiv straight and level and collect more reliable bearings to the target. Also, the 
sensors position is known more precisely since it 1s not decelerating and accelerating 


into and out of turns. 
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HI. KALMAN FILTERING 


A. INTRODUCTION 

The technique of Kalman filtering 1s ideally suited to the problem of passive 
tracking. The following sections briefly describe the theory and results of Kalman 
filtering and how it is applied to the long range airborne TMA problem. For a more in- 


eeoenceveclopimen: of the Nalman filter, the reader is referred to [Refs. 1,2]. 


B. THE KALMAN FILTER 

The purpose of the Kalman filter is to keep track of the state of a svstem 
through a sequence of noisv measurements. This 1s accomplished by recursively 
updating an estimate of the state by processing a sequence of noisy observations in 
such a manner as to reduce as much as possible the effect of measurement errors. 

The Kalman filter 1s a predictor-corrector type estimator that propagates an 
estimate, X, of the target state along with an associated covariance matrix, P. which 
Weleetseticedcecres Of comfidence placed in the accuracy of the state estimate. The 
Kalman filter is carried out in two alternating stages. First, previous estimates of x 
and P are extrapolated one time step ahead based on the assumed system dynamics; 
this is referred to as the Movement Step. These extrapolated values are then used to 
compute a set of optimum weights called Kalman gains. The gains are applied to the 
prediction and to a new observation in a Measurement Step, which provides an 
updated estimate of the state and its covariance. This process is then repeated. [Ref. 3] 

1. Assumptions 

The following assumptions are made: 
1. The random forcing function w, is zero mean and uncorrelated with covariance 
Q:.- 


2. The measurement noise Vy. is zero mean and 1s correlated with covariance R,.. 


2 


The random forcing function w, and measurement noise v, are uncorrelated. 


+. The iniual state X, is a random variable with known mean Roy 1 and covariance 
F oj-1° 


I 


2. Definitions 


1. The estimated state vector after k observations is denoted by Xk and the 


a 


predicted state vector before the k" observation is represented by Xe ipey: 
2. The state estimation error vector € is defined as the difference between the 


estimated state and the true state 


_ A 
Ca 


k > Xa 7 *x (eqn 3.1) 


and the predicted state estimation vector & ,_, is defined as the difference between 


the predicted state and the true state 


“A 


Sted = Nger 7 X (eqn 3.2) 
3. The covariance of estimation error matrix P,,, 1s defined as 
PL, = Ele, 2") (eqn 3.3) 
and the predicted covariance of state error matrix P,,, _, is defined as 
= i 2 
Gh oes ac ome (cone 
4. The state excitation covariance matrix is given by 
Q =E rw wrt) (eqn 3.5) 


5. The Kalman filter is an optimal estimator that minimizes the sum of the 


Variances oi the estimation error, 1.e., 


Bie (ky) = Ejes(h cee ame om cag (eqn 3.6) 


20 


Enter known matrices and a priori estimates: 
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Compute the Kalman gain: 


Gay = Pogk-H CAPA yHT + Rg} 


Xcxik) = Rainer) + Gayl 2a 7 AR gna 3 
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Figure 3.1 Kalman Filter Algorithm. 
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3. Kalman Filter Algorithm 

Figure 3.1 summarizes the discrete Kalman filter algorithm. For the particular 
TMA problem presented in this thesis, the 2X 4 measurement matrix H, and the 4x4 
state transition matrix @, are both known, constant matrices and may be represented 
by H and @. An a priori estimate Xe of the target’s state with an associated initial 
error covaniance matrix Poy as Well as an initial estumate of the measurement noise 
covariance matrix Ry must be input into the filter algorithm. The algorithm computes 
the Kalman gain G, based on these a priori values and then updates the estimate of 
the target’s state when it receives a measurement. The error covariance matrix is also 
updated. Next, the state estimate and its error covariance matrix are projected one time 
step ahead based on the assumed system dynamics. The measurement noise covariance 
R, and the state excitation covariance matrix Q, are then computed before k is 


incremented by one and the whole process 1s repeated. 


C. FUNCTIONS, MATRICES, AND EQUATIONS 
In this section, the Kalman filter algorithm will be applied to the long range 
passive airborne tracking problem. A brief derivation of the random forcing function 
w,.. the state excitation covariance matrix Q,, the measurement equation z,, and the 
measurement noise covariance matrix R, is given next. 
1. Random Forcing Function 
Recalling equation (2-6), the two dimensional random forcing function w, 


represents the acceieration in the x and y directions caused by target maneuvers. 


¥,5g + (X46, 


= XpOneee Oy ee (eqn 3.7) 





: Deluee 
where \ ae 


wl oe ee: 
Tom 


Since the random variables 6. and Og were assumed to be zero mean, it 
follows that the random forcing function w, is also zero mean. The variances of the x 


: » . 
and v accelerations, denoted by Guy and om respectively, are 


- \& 
mn 2 2 
G. = E | x] = % % + xs) o, (eqn 3.8) 
9 I) EL 4] = 0 & 2 oye 2 (eqn 3.9) 
oe a 4k i C; + a cS, qn oO. 


ye 


The covariance of the x and y acceleration Ors" 1S 
Go = Els, yl = —-x Ge + Hae (ean 3.10) 
Ky k Yk) = ~¥%e ¥K% you qn 2. 


Therefore, the random forcing function covariance matrix Q, 1S 


& 2 
} 5 “Key 
Q. = E{ Mah, me } a ot ot (eqn Sei) 
ey TY 
Where c. ; o,° , and O55 are computed at the predicted values of x7 and yr. 


2. State Excitation Covariance Matrix 

ne purpose of the state excitation covariance matrix Q, is to account for 
model inaccuracies or for a target that has maneuvered. It is basically a “procedure for 
masking the effects of modeling errors” [Ref. 2: p. 163]. In effect, the state excitation 
covariance matrix increases the size of the predicted covariance of error matrix which 
In turn increases the filter gains. As more observations are processed, Q, prevents the 
Kalman gains from approaching zero by continualiv injecting uncertainty into the 
predicted state estimate at each iteration. A nonzero Q, slightly degrades the filter’s 
accuracy when the target 1s not maneuvering but it helps prevent filter divergence when 


the target does maneuver. As stated in equation 3.5, the state excitation covariance 


matrix 1S 
signee Te 2 mB 2 ee 2 
ca 3 — oO. ae : 
22 T° 2 
a Te 7%, To, 
One Oo. | = (eqn 3.12) 

T'32 cee 
iwiey 2. 9 

SYMMETRIC 
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5. Measurement Equation 
In this TMA problem, the observations are noisy (x,v) positions. It is the 
intersection of noisy lines of bearing that form the noisy (x,y) position of the target 
that is input into the Kalman filter algorithm. Because the observations are of the 


same form as the state vector, the measurement equation is linear and is expressed as 
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Z, = Th X, aaa (gan 3-15) 


where z, is the 2X 1 measurement vector 
H 1s the 2 * 4 measurement matrix 
v, 1s the 2 X 1 measurement noise vector 
X, is the 4 X | state vector. 


The equation may be wnitten explicitly as 


ay 

Ze _ i000 Xp - Vix 

zy 00 1 0 Vy Voy (eqn 3.14) 
Sas 
= 


The most important part of the measurement equation is an accurate description of the 
measurement noise vector v, The measurement noise vector expresses the statistical 
nature of the noisv (x,v) position that 1s derived from the intersection of two noisy lines 
of bearing. These bearing measurement errors are assumed to be independent and zero 
mean with variances cra and Gnas for sensor | and sensor 2 respectively. 

It 1s important to note that the bearing errors between sensors are statistically 
uncorrelated; one sensor's bearing accuracy has nothing to do with any other sensor's 
bearing accuracy. However, in describing the resulting intersection in Cartesian 
coordinates, the noisv x and noisy y positions are correlated. The only case where the 
noisy x and noisy y positions are uncorrelated is when the lines of bearing are 
perpendicular. 

4. Error Ellipses 

An intuitive Way to visualize the measurement equation 1s through the concept 
of error ellipses. Error ellipses give a geometric picture of the region around a noisv 
position or estimate where the true value is considered to lie. Figure 3.2 shows a 
of bearing with independent Gaussian distributions. 

As can be seen in Figure 3.2, the lines of bearing intersect at an oblique angle, 
forming an asymmetric hump. While the bivariate Gaussian probability density 
function gives an interesting three dimensional! depiction of two normally distributed 


bearing errors, it does not provide the information that 1s really needed, quickly. What 
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Figure 3.2 Bivariate Gaussian Probability Density Function. 


1s needed 1§ an accurate picture of the measurement (or estimation) error. This 
UMeetiai Mig siseoest expressed Seo metically Oy the error ellipse. [he term “error ellipse’ 
fjcewio (de sino dimensional surface of constant probatility density: Figure 3.3 
presents these error ellipses as contour lines of the bivariate Gaussian probability 
density function shown in Figure 3.2. 

The various ellipse sizes in Figure 3.3 correspond to different constant 
probabilities. The fact that the ellipses are also rotated implies that the uncertainty in 
measuremenit error 1s indeed correlated with respect to x and y. The actual probabilities 
within a specified error ellipse mav be computed through lengthy integration of the 
bivariate Gaussian probability density function over the surface of the ellipse. Some 
computed probabilities of the true value lying within the lo, 206, and 30 error ellipses 
are .394, .865, and .989 respectively [Ref. 4: pp. 4-49]. 

Error ellipses are extremely useful in examining postion error. Matrices 
containing the x and y position terms convey analvtically what error ellipses display 
graphically. A 2 X 2 error covariance matrix which contains position components x and 


v is able to completely describe an ellipse. The main diagonal terms represent the 
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Figure 3.3. Error Ellipses as Contour Lines. 


variances of the x and y positions respectively. [The off diagonal terms represent the 
degree of x-v coupling and the orientation of the error ellipse in the x-y plane. 
5. Covariance of Nleasurement Error Matrix 

The covariance of measurement error matrix R, uses the concept of error 
ellipses to accurately describe the noisiness and degree of coupling of (x,y) 
measurements obtained from intersections of noisy LOB’s. The terms of the covariance 
of measurement error matrix R, depend on the standard deviations of bearing error 6, 
and 6, of sensors | and 2 as well as the angle at which the lines of bearing intercept. 


The covariance of measurement error mav be expressed as 


r 7 


2. 2. 2 2 2 
Ci: sinQ, ~ 6;. os 6, -¢6,: Stn 6, cosO, ee oy. cos 9, sin8, 
cos’ (8,+ 6,) cos" (8,+ 8.) 
R = (eqn 3-15) 
| 2 
-o sin8, cos, — Gy, cos 6, sind, of cof 8, ays of a 8, 
cos*(8,+ 8,) Bos (9.4 é,) 
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where 9, and 0, denote noisy bearing observations from sensors | and 2, respectively. 
The subscript k has been intentionally deleted from equation (3-15) only for ease of 
notation. At each discrete time interval t, new values of 0, and 0, are generated with 
Which to compute the new measurement error covariance matrix, R, A complete 


derivation of equation (3-15) is given in Appendix A for the interested reader. 
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IV. THE ALGORITHM 


A. INTRODUCTION 
This section discusses the development of the tracking algorithm. The algorithm 

is designed to simulate tracking a long range inbound enemy air target by triangulating 
noisy bearing observations from two airborne sensors. We want to be able to track a 
non-maneuvering target within a one percent range error. For a maneuvering target, 
we desire a stable filter response which quickly converges to the target’s new state. The 
effect of various sensor bearing errors, a priori state estimates and initial error 
covariance matrices on filter accuracy and convergence time are investigated. Also, the 
effect of target maneuvers on filter stability is analvzed. Basically, the algorithm 
performs three functions: 

1. The target and sensor tracks are generated. 

2. Noisv bearing observations are simulated using a random number generator. 


3. The noisy measurements are processed by the Kalman filter algorithm to 
generate estimates of the target's state. 


B. TARGET TRACK 

As mentioned in Chapter 2, three target track scenarios are investigated: 
nonmaneuvering. gentle turn. and hard turn. In all three cases the initial target position 
is (410 nmi, 430 nm) with XA and Y velocities of —400 knots and ~380 knots 


FeSpectivelne 


C. GENERAL SIMULATION SCENARIO 

The overall purpose of this simulation 1s to be able to track an inbound enemy 
aircraft before it flies within 300 nmi of the high value unit. By using two sensors which 
are essenuully able to “peek” over tne norizon, a jong range OTH ngnter intercept of 
the target aircraft mav be accomplished. For all simulation runs, an initial target range 
of 600 nmi is chosen. This allows the sensors to passively track for thirty minutes, and 
it enables fighter intercept to occur beyond 450 nmi of the HVU, depending on the 
fighter’s initial position and fuel state. The target aircraft is also assumed to be flving 


inbound at approximately 600 knots. 
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|. Algorithm Flow 
The algorithm can be broken down into the following steps: 
1. Define the true target track. 


tJ 


Define the observer tracks. 
2 


Ge 


Enter ooo estimates Xqj_y, Pope and Ro. Enter bearing error variances S, 
and 0,°. 


4. Compute the noise free bearings from each sensor to the target for each time 
interval. 


in 


Compute random sensor bearing errors using computer generated normal 
distribution. 


6. Add the random bearing errors to the noise free bearings to create noisy 
bearing measurements. 


~4 


Compute the noisv (x.v) position that results from the intersection of two noisy 
LOB’s. 


S. Input this notsv (x,v) measurement into the Kalman filter algonthm. 


D. TARGET TRACK 

As mentioned in Chapter 2, three target track scenarios are investigated: 
nonmaneuvering, gentle turn, and hard turn. For all scenarios, the initial target 
position 1s (410 nmi, 430 nmi) with x and y velocities of —400 knots and — 380 knots 
respectively. For the scenarios where the target maneuvers, a value is input for the time 
tnat the maneuver 1s to take place. Also. values for the x and y velocities are input for 
eee mere) (ie (erec: dae. it Should be noted that the turn radius of the target 
is not taken into account in the target track. for at the extreme distances being 


investigated, target maneuvers almost appear as point turns. 


E. OBSERVER TRACKS 
The observer tracks each begin at 295 nm: on their respective axis and travel 
indound at 420 knots. These observer tracks were chosen to be inbound to represent a 
miOre jedisscic. WOrst case type scenario. Ideally, tt 1s desired to have both observer 
Pe Oe ena eet eernen dics 
constraints and maximum on-station time for the observer aircraft are important 


practical considerations that must be taken into account. 


Fe INITIALIZATION 
In tne first series of simulations, different combinations of the initial state 


estimate Xoj., and the Initial error covariance matrix Poy. are tested. For the first 


simulation, and the one by which the other simulations are compared, the a priori state 
estimate 1S 


400 nmi 
: _ 420 knots 
=o! ~~ | 400 nmi 
420 Knots | 


and its associated initial error covariance matrix 1S 


(50nmi)? 0 0 0 
0 (SOkts)* 0 0 
Poe aie : ae 
0 0 (50nm1) 0 
0 0 0 (5Okts)> 
=I 


The initial measurement error covariance matrix for the one degree bearing error case 


1S 


(7nmi)* (Snmi)? 


(Snmi)? (7nmi)* 


G. NOISY BEARING GENERATION 

The Box-Muller method is used to generate normally distributed bearing errors. 
Basicaliv, itis a mapping technique that uses an algebraic identity to establish a one to 
one relationship between a uniform random variable and a normal random variable. 
Two random U(0,!) numbers, L, and L,,are transformed into independent N(0,1) 


rancom numbers, N, and N, using the equations 
N, = (=2inU ee cost 


N, = (= Jina? sings 
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Figure 4.1 Normally Distributed Beanng Error. 


Figure 4.1 presents a histogram showing the normal distribution of the bearing error. 
These normally distributed random numbers are then muluplied by the standard 
deviation of measurement error for each sensor to produce two independent normallv 


distributed bearing errors for 0, and 8, 
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V. SIMULATION RESULTS 


A. INTRODUCTION 

The purpose of this chapter is to show through various scenarios the effect of 
different initial state estumates and measurement noise levels on the stability, accuracy, 
and convergence time of the algorithm. In the following pages, fourteen simulations 
involving three scenarios are presented. As shown in Figure 2.4, the three scenarios 
include a nonmaneuvering target track, a target track with*gentle turn, and a track with 
a hard turn. The first scenario provides the reference with which other cases may be 
compared. Unless otherwise noted, all simulations use a two second time interval 
between measurements. Also, all of the simulation results depict the cases of one 
degree and five degree sensor bearing errors. It should be pointed out that in order to 
isolate the effect of various parameter changes, a single random number seed is used 
throughout to represent a specific noise history. There has been no attempt to create 
Statistics based on ensemble of noise histories due to the extreme computational time 


Fequined: 


B. TYPES OF GRAPHS 

Five graphs are used in all simulations. These include the x and y positional 
errors, the x and y velocity errors, and the percent range error. or the cascuon 
positional errors, the updated state estimate of x and y position is subtracted from the 
target's true x and y position. Likewise, for the case of velocity errors, the updated 
state estimate of velocity is subtracted from the target's true x and v velocity. Range 
percent error is computed as 

Range Percent Error = [R= Ref x 100 
Rr 
A 

Where Ry denotes the target’s true range from the ongin and Ry is the updated 
estimate of target range using the updated state estimate for the x and y positions. In 
some simulations, the measurement residual error is plotted. The measurement residual 
is defi.::d as the difference between the actual noisy measurement and the predicted 


state estimate. It may be expressed as the quantity 


Z, ~ AX) 
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C. SCENARIO 1 

Scenario 1 consists of ten simulations that demonstrate the effect of various a 
priori estimates, measurement noise levels, and time intervals between measurements 
on filter performance. In all ten simulations, the target 1s on constant course and 
speed. Figure 5.1 illustrates the target’s true track along with noisy measurements. 
Note by the scale that only a portion of the first quadrant is depicted. In the first 
simulation, the initial difference between the true target state and the initial state 
estimate 1s 


10 nmi 

20 kt 

30 nm 

40 kt 
& 


and the a priori error covariance matrix 1s 


(Onn) © ,o oO 
pS o (50kt) oO ,0 
ol-) - Oo © (S0..m:) © 
o Oo O (Sok) 


Overall, it can be seen that for the one degree bearing error case, the algorithm 
tracks quite well. Referring to Figure 5.1, the x velocity error initially gets worse before 
It gets better. It 1s not until after five minutes have elapsed that the x velocity error 1s 
less than the a priori estimate. As can be seen from Figure 5.1, the tracking accuracy 
for the five degree bearing error case is fair. The one degree bearing error case 
G2 mem sdemonstfates Guien ana accurate filter comvergence: the five degrec bearing 
case seems to meander almost randomly. The sudden rise for the five degree case seems 
to be an anomalous disturbance. The x and y velocity gains are directly related to 
bearing accuracy; the higher the accuracy, the greater the gain. For the five degree 
Pcanimemeenorcase. {he velocity gain mever exceeds 0.2. 

The following nine cases are basically variations of the first case. Table 1 lists 


the parameters that have been changed for each case. 
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TABLE 1 
SCENARIO PARAMETER CHANGES 
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X AND Y POSTION GAINS VS. TIME 


X AND Y VELOCITY GAINS VS. TIME 
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TRUE Y — FILTERED Y POSITION VS. TIME 


TRUE X — FILTERED X POSITION VS, TIME 
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VI. CONCLUSIONS AND RECOMMENDATIONS 


Do CONCELESTONS 

lieve UT eese oC! fits taesis was tO Investicate the two sensor bearings only passive 
tracking problem using Kalman filtering techniques. A computer simulation was 
developed to generate the target track and the noisv bearing observations from each 
Sede en tem periOlmance was EXCeDuOndal 7Or the nonmaneuvering target case. With 
one degree sensor bearing error and two second measurement intervals, the filter was 
able to consistently track the target to within one quarter of one percent range error in 
the fist five muntices, A\stvas expected, filter accuracy was degraded as bearing error 
was increased. The tracker performed reasonably well for sensor bearing errors as high 
esecicne Gecnees. 

For the case of a maneuvering target, filter performance was marginal. Filter 
convergence to an accuracy attained prior to the target maneuver did not occur. The 
use of a state excitation covariance matrix by itself was not sufficient enough to 
properly account for target maneuvers. What is needed 1s a reliable zig detector that 
quickly recognizes target maneuvers so that the filter gains may be reinitialized. The 
probiem of detecting target maneuvers is not trivial. At long ranges, error ellipses may 
be twenty to forty times larger than the actual distance the target has moved. Sifting 
out a bona fide target maneuver from these extremely noisy measurements is quite 
Gifficult. Determining a target maneuver by attempting to find a pattern in the 

easurement residuals is only successful if the time between measurements 1s greater 
than thirty seconds. A drawback to this approach is that filter accuracy is degraded 
because fewer measurements are being processed. 

From the simulation runs it was found that the most influential factors in 
determining tracking accuracy and speed of convergence were the sensor bearing 
accuracies and the time between measurements. Factors that contributed to a lesser 
extent included the accuracy of the initial state estimate along with its associated 
degree of confidence and the positions of the sensors. Inaccurate a priori information 
did not degrade the filter’s accuracy, it only increased the time for convergence. Filter 


accuracy improved as the lines of bearing came closer to being perpendicular. 
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B. RECOMMENDATIONS 
Tnis studv is by no means complete. Some areas for further study include the 
following: 


|. Run an entire ensemble of simulations (perhaps 1000 runs) to generate reliable 
staustics on the filter's performance. 


tJ 


Investigate more fully a method to detect target maneuvers so that adaptive 
control techniques may be used to alleviate the problem of filter divergence. 


Examune the utility of using more sensors to cover a comparable sector. Are 
more sensors necessarily beneficial? 


(423 


4. Perform the simulation using a different coordinate svstem (such as polar 
coordinates) and compare the results to those obtained using a Cartesian 


model. 


APPENDIN A 
DERIVATION OF MEASUREMENT ERROR COVARIANCE MATRIX 


In this appendix the measurement error covariance miutrix R, 1s derived. 
Recalling the measurement equauon from Chapter 3, the measurement noise vector v, 
is assumed to Ce Gaussian and zero mean with variance R,. That is, 


Poa SUK 
‘kK (OR) ) (A-1) 


The purpose of R, is to statistically describe the noisiness of the x and y measurements 
Coieincautarour toe simmersecnon oO. moiss lines of bearing. Basically, the 2 by 2 
jeasurement error covariance matrix describes this noisiness by displaving the variance 
and covariance of the noisy x and vy measurements in terms of each sensor's bearing 
measurement and accuracy. Referring to Figure A.1, the position (X7.Y7) represents 
a possible true position of the target based on noisy sensor bearing observations, 0, 
and Ue: The position of the target CSar oy) is a jointly distributed random variable 


whose expected value coincides with the intersection of the bearing lines. 





(0,0) os SENSOR | x 





Figure A.! Target Observer Geometry Revisited. 


oT 


To develop the relationship between X+ and Y-7. the LOB’s from each sensor 


mav be expressed in the general form for the equation of a line: 


x sin 8, + y cos 8 =X sin8 


¢ (A-2) 


x cos O, = y Sin G, a Y2 sin OF = © (A-3) 


The distance from the position (Ay, Yy) to each sensor line of bearing is denoted by 
d, and cd, for each sensor LOB respectively. From the problem geometry and bv using 
the equation for the distance between a point and a line, the displacement distances d, 


and d, may be expressed as 
d= t[(Xp-x)) sin + Yecos 8] (A-4) 
d, = | xX, cos 6, + (Y-4) Sin @, | (A-5) 


Since both sensor bearing errors are assumed to be Gaussian zero mean random 


2 


variables with bearing variances 0,“ and 6°, it follows that the displacement random 


. . ° . : 4 
variables d, and d, are also zero mean Gaussian with displacement variances 6,7 and 
C, respectively. Figure A.2 illustrates the relationship between the displacement 
variance and the sensor bearing error variance. 





Figure A.2 Relationship Between Bearing and Displacement Errors. 


In this figure, the bearing error standard deviation for sensor 1, 6,. 1s expressed 


in degrees or radians whereas the displacement error standard deviation for sensor I, o, 


miseemprcssca mimaltical miles. They are related bv 


(A-c) 


O,v-= fr tan 6, 


Where r, is the approximate cistance from sensor | to the target in nauucal mules. 
Therefore, the displacement distances d, and d, are normal random variables that 


meme be Written as 


o 2 
eae NG (A-7) 


(A-8) 


eee NO, G7) 


Having described the displacement random variables d, and d, from sensor | and 


sensor 2 lines of bearing. equations A-4 and A-5 may be rewritten as 


oes Sin 6 o Ne cos 0 = x, sinQ + N, (A-9) 


i cos O, + Yr sin oy ¥2 sin 6 2 N, (A-10) 


: Solving equations (A-9) and (A-10) for 


where N, = N(0, 6,7) and \, = N(0. ./). 


Av and Y-y yields: 


Vane a2 sin 0, cos 9, - x, sin sin O, +N, cos @ - N, sin 
, = Bf guee races 1) SIN, + Neco 
cos (6,+6,) 
x, Sin 8, cos &, Ty Fe Sin 8, Sin 8, + N, cos 8, ~ Ni, sin8, 
cos (6, +6,) 


“As Re = Ae Aig Ny DAN, 


Y, 
(A-11) 


(A - 12) 


B, + BN, + BN, 


Y 
where A, - 42 Sin 0, cos 8 ~ X, Sen 6, Sin 0, 
cos(6, + 6, \ 





Cay 
Land 


and A, = 73in®, Awz £038, 
cos (6, +@,) e cos (8,48) 
B = Xx, sin G, cos b, - % sinGi sin 
: cos (6, +8, ) 
cos 6, —Sin 8, 


B, : cos (8,81) B= cos(G,+ 8,) 


Note that since X7~ and Y- are linear combinauons of normally distributed random 


variables, thev must also be normally distributed. That ts, 


~~ i Z 
<i en ae (A-13) 
rw 2 
a aa) (A- 14) 
where ho A, 
I ae if D 
RS BS Gr Pg 5p (A- 15) 


and Hy = B, 
2 ae 2 2 2 2 
oi a Be tA a B rd 
°Y; 3 87 3% (A-ic) 


Now, the measurement error covariance matrix R may be written as 


Var(X7) Cov(X7, Y7) 
Cov(X7, Yr) Var(Yy) 


By definition, the covariance of the random variables Xz and Y7 1s the expected 


value of their product minus the product of their means. That is, 


Cov(Xq, Yp) = E[X7 Yq] ~ ex y. (A-18) 


Substituting equations (A-11) and (A-12) into the above equation vields 


Cov(X,, Y,) = E[(A.+A2 N, +A, N, ) (6,+ BN, 8,N,)} - AB (A-19) 


$4 


By noung that N, and N, are zero mean, the expected value of their product is the 
Gaeane  sOletheimemeainsa | hat 1s, E[X,2] = £ IN] E(N3| ame SiMe (IS fact. 


the covariance between the random variables Az and Y+ is simplified to 


5 


Cov(Xy. Yz) = A,B, 6,7 + A, B, 6,7 (A-20) 


Substituting equations (A-15), (A-16), and (A-20) into equation (A-17) enables the 


measurement error covariance matrix R to be written as 


zt | z 
~ + AL es : 2 
R _ A, 6; S53 lay 6, cw, + A, Bo, 
2 2 2 2 2 


Lastly, substituting the vaiues for A, and A, into the above equation yields the final 


expression for the measurement error covariance matrix 


2 2 2 Econ 2 
yr sinO, + 6 cos G, efit sin, cos, - 6, cos s..6, 
ee eee 
cos*(0,+8, \ cos (0,+8,) 
een 
-C, sin 8, cos @, - oF cos 8 sin8 s cos 8, + os. sir 8, 
cos(9,+ 8) <os'(@ +) 


APPENDIX B 
SIMULATION PROGRAM LISTING 


VY KALMAN 
A THIS PROGRAM IS A TWO-SENSOR KALMAN FILTER TRACKING ALGORITAM. 
2 


aTHE FOLLOWING IS & poe OF THE PRINCIPAL CoE USED: 


ror 14 


eae oeoeeoevoeeeee AP EIORI SLAZE ESTIMATE 

£1 ,B8E 2%. cee eee . NORMALLY cea BEARING ERRORS 
Dr = © 19) «9 one tererietenetteires TIME STEP CingiCurse 
DET ccc. ease w% eae PosTrron ERROR (TRUE-PREDICTED ) 
Me i aesens saeuetenealts ~KALMAN GAIN 


Se HEASUREMENT MATRIX 
RO PHEPAL "NTHETA2. .NOISY BEARINGS FROM SENSORS 3 AND 2 TO TARGET 
ANZ. sss sees esses + «MEAS URED X ea eee x) 
aP.....———— one BEROR COVARIANCE MATR 
RPT. ee ee . STATE ooh NSITION MAT BTN 
D0. ccc ccc eee eee STATE EXCITATION COVARIANCE MATRIX 

cs ere MEASUREMENT NOISE COVARIANCE MATRIX 

. PERCENT RANGE ERROR 
. RADIANS TO DEGREES 
.. LIME VECTOR radi MINUTES) 
. . PRUE TARGET VELOCITIES IN X AND Y DIRECTIONS 

“SENSOR 1 AND SENSOR 2 VELOCITIES 
+ STATE ESTIMATE 

. VECTORS OF TRUE TARGET POSITIONS 
. VECTORS OF TRUE SENSOR POSITIONS 


ayX4i VY2. 
aAXHA 

AXTK, YOR. 
aXxik, en. 


A 
QA & Oe OK oe Ok ok ke ok ok ok ok ok ok kok Kok kk Kok wk OK ko kw ow ow Kw KK Ow OK Ow Ow KK KK OK KK Ow Ow KK OK KO OK KK 


A 
a INITIAL CONDITION INPUTS: 


A 
aA' INPUT DESIRED RANDOM LINK: '! 
RLUSAVE<QRL<265067500 


J A 
HH 
rd 
J 
i 
a 
i 
J 
a 
| 
A 
5 
: 
: 
, ene MANY ITERATIONS ARE TO BE RUN (KK)?! 
JA 
J 
3 
J 
i 
i 
] 
] 
3 
J 
J 
i 
J 
i 
J 
i] 
] 


"| ENTER TRUE TARGET PARAMETERS: XT0,VXF,VXS,YT0,VYF,VYS' 
TRUESTATE<D 
XT <TRU ES eee § 1) 


ae 
7YsTRUESTATELS 6] 


Berea THE TARGET GOING TO TURN (WHICH ITERATION NO. ):' 


A 

'NEXT eae SENSOR 1 AND SENSOR 2 POSE TION AND VELOGIZ. | 
'DATA AS 410 ,VAl,2 205 22 

SENSPOS<0 

K1 oe aon 

VX1<SENSPOS 

Y20€SENS 20583 


VY2<SENSPOS(4Y 
A 


Q 
nee STEP TO BE USED (DT ,IN SECONDS )?! 


DiSGvT 

1 DI <Rz 3600 

i 

] A'NO. OF POINTS TO INCLUDE IN THE REGRESSION: ' 


CW eae ea Ie Ae Ae An IIE IIe eerie ee 6 AE Ieee ae eae oie oo 
ONnnIninnininninFFEFE FEES FWWWWWWWWOWPDPDADPPD PDD DP PPR PH RPP P10 ONO rH 
OW ONAN E WPdkh OWONIANNF TIMP O1DW@dO~ YOM FL WPPOWO~NNMM FWHOPOWOWAONF WPPR OL se se bot te 
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LES UE aE oy Ve len) | Cel 
Sc Sees 


fF WO RPOWO~1MHOIL WpPor 


Jt UL. NLL 8 tk ek at 


BREED Dap ahd DD RD 8 10 1010 2 LL WZ (1H) 2.0 DW © 00 0 OH WO WMO YYYQUYV YQ YIM HNHAMGAAHHOM 


DMNMNMNNNNNNNNF HERR RRR ROOOOOOODOOOWONOM FE WMOPOW ONO WrproMmwwaoOum 


VEE VE AAA Ir AE Aaa IF Waar arr amir ie arr arma esac area 
OW OnONnEWMrOrPOWOANIMAMHNFE WPOPOW ONO FS WHR OWI tt tt i tt tt ttt 


AaNRP<Q 
Pp 
| NOW ENTER ALL A PRIORI ESTIMATES AND MATRICES: ' 


Q 

\ INITIAL GUESS XHAT (FOUR ELEMENTS MUST BE ENTERED): 
AAT} 

KHd7<6 1 oXHAT 

vunes 


AGOnAL Ere DIAGONAL ELEMENTS (FOUR ENTRIES):' 
do,=14)x 44 ODIACONAL 


26 DIAGONAL POSITIONAL AND VELOCITY COVARIANCES (2 INPUTS): 
mllcOrFDIAC(1) 


C 
}e +3339 ORFDTACT OI 


02 
< 
B 
= 


pr R MATRIX (4 NUMBERS IN THE ORDER UL,UR,LL,LIR):' 
< 


PSAVE<R<220R 


Q 

a SET UP SOME VECTORS ae TO GENERATE THE Q MATRIX. 
aC<( (01 )#(4x3600) )*«2 

aFi<1 2 7 22-2 

AP1<Fi, 

ergeud 224 u 1092 

9F2<(804),84F P2 

aFu<e UY 3 Saas ec 

AFUCFY FY 


! 
ane MAX BEARING EAROR IN DEC. FORTHETA1 AND THETA2 (22 INPUTS ):' 
< 


Cease 
oO 


vie kK iW vk ok ok ie ee ik ko ev oie i ie i ie ie oie i ieee ei oie oie ie ke kk kk kk ok ok ok 


A * 
Q 
A INITIALIZED STORAGE VECTORS FOR GRAPHING PURPOSES ONLY 
Q 


CVSTORE<QCSTORE< ee eee en DERRSTORE<(2,K+1 )p0 
RNGPCERRSTORE<QMSAVE<(1,K+1)p0 


a 
a THE FOLLOWING OUTER LOOP IS FOR GRAPHING THREE SETS OF SENSOR BEARIN 
A ERRORS ON THE SAME GRAPH. THE TRACKING ALGORITHM IS, IN EFFECT, BEIN 
a eee WITH EACH RUN USING A DIFFERENT PAIR OF SENSOR 
A i 


Q 

MAINLOOP+1 

TOP: BRGERR+B6[ (~1+2xMAINLOOP) ,2xMAINLOOP] 
P<PSAVE 

R<RSAVE 

XHAT<©APXHAT 

21<BRGERR(1] 

A2<BRGERR(2] 


Q 
ppand UP q MATRIX INITIALLY TO BEA UX MATRIX OF ZEROS. 
€ Ly 9 


A 


LAE PURPOSE OF THIS PROGRAM SECMENT IS TO 

STABLISH TRUE TARGET TRACK (WHICH INCLUDES TWO LEGS} AND SET UP 

SEN ee 1 AND SENSOR 2 7RACKS. NOISE-FREE BEARINGS FROM EACH SENSOR 
HE TARGET ARE COMPUTED. NOISY ZERO-MEAN NORMALLY DISTRIBUTED 

iBtNG ERPORS ARE GENERATED AND THEN ADDED TO THE NOISE -FREE 

ARINGS.FROM THE INPERSECTION OF THESE NOMS Lon Ss 2HE NOISY 


t_Jt_se_st_it_tt_st_se_ t_tt_e_se_si_it_t_ste_tt_it_tt_tt_tt_ttierir_it_ntiitiires jy D 
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ay 


Qo Ye ek ek oe ok eo ke oe Oe oe ie ie ie ie oie ei ie ie oe ie oii oie oii oie ieee ieee aie ioe ee oe 


CN Tee ee EI TET III AAR TE AIC AC TAMA OIC ATI arte ac ae 1 TE eae ET I EI oe WE Wee Ee eT eet 
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2 0D.10.10.00: 12.010. WD. Zt) © / 00 020. 00 00 00 00 CK CKO SININIIINININSINI SIN OMOMMNMOHWOOOOMIMWAMWINKNNIUOOELLEL EE EE FwwWwwwwwwwa 
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a (X,Y) POSITION OF THE TARGET IS COMPUTED AND STORED FOR LATER USE 
a IN THE TRACKING FILTER AS THE TARGET'S 'MEASURED' POSITION FOR 
a THE KTH TIME ITERATION. 


A 
a SET UP SOME INITIAL GALCUEAT IONS: 
TK<DTx0,1K 

TRM<TKXEO 


Q 

XPRF<XTO+V S61 xDTx0 ,1 TURN 

XTRS<( 14 XTRF)+VX021xD2Px1 (K-TURN) 
CHP ly rer | XTKS 
VIRF<YTO+VY(11xDTx0 ,12URN 

Y7TRS<( 1+YDRF)+VYC21xD2x1 (K-TURN) 
YTR<YTKF , YTKS 


@} 
X1K<X10+VX1xTK 
Y2K<Y20+VY2x7TK 
QA 
R2D<180¢01 
LVX<X1K=XTK 
LVY<Y2K=YTK 


R 

FEET ee hee SS ee oe 
THETA2K<((CY2K<YTK) X01 J gO CA Oi eae 

A 

CEE Luan Oe Ca a ee 
THETA2K<(LVYx0.5xo1 )+(~LVY )xTHETA2K 


Q 
ACONTINUE WITH CALCULATIONS: 


A 
ADATAPOINTS<(2,NRP) 

RNGPCERRSTORE<MSAV <0 

ibro Biioo L ORE GN Zeee 

CUSTORE <7 ERRSTORE<ERRSTORE<BSTORE*CSTORE*NZFIX+ CZ4+ 1 ie 


A 
XHATSTORE< 4 1 90 
PSTORE< 44 00 


PHT<(14)o.,= 

PHT(1;2}<D? 

PHI(C3;4j<D7 

AACCEL<0.5xDTx 

AaGAMMA< 4u 2 pACCEL, O,D7 ,0,0, ACCEL Gye 
T<(14)°.2=14 


eC 
*h 2.2.2. 2,.8,2,.8,28,2,8,0,8,08,0,8,.8,0,.8,8,0,0,0,28,8,8,8,2,8,2,0,8,8,8,8,0,0,8,8,8,8,0,0,08,8,8,8, 0,8, 8,8,8,8,8,8,8, 8,8, 8,8) 


A 
a START MAIN LOOP: 
Q 


N<1 
je] 


je] 
LOOP: G+P+.x(QH)+.xBR+H+.xP+.xQH 
A 


A 
a 'KALMAN GAIN: ! 


fA 

GVSTORE(13 3 
GVSTORECL2:N 

GSTORE(13N; 
GSTORE(23:N] 
AG 

a 


mr7GQgy Gy 


< 
< 
G 
G 


f— 
— 


Q 
P<(I-G+.xH)+.xP 
PSTORE<PSTORE, [O0.5x1+1<N] P 
A 


A 
a'UPDATEDIS?! 
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CIE TIE WAI TIE AE ETA ETA EAA AI AIA A ar Warrant carretera $ 
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NOOMDMOAOOMNOOUIMAAINIHOAOE FEE PEELE EWWWWWWWWWWHNNYNPINNNNNRPE PRP RPP PPB OOOMOOO0O0O 
OWDONOWFE WOR OWONME WHR O(MON MUTE WNP OUMON MANE WN ROW ONDE WNOPOM MUNN FWOrPOWMOUMDULWOP 
i a a kt ee Le 


D 
'y 


Mie Ox VIG YRC | 

a'TRUE TARGET POSITION ' 

AZK 

A 

8 THE NEXT SECTION GENERATES 2 NORMAL BEARING ERRORS. 
a 

U<(?2e10%19 )t 10*10 

SSO ( 2xeUtil )x rs 

SP21<A1+ ee eae Be 

euicee os ee <a 6 

ESTORETL a N3<BE1<+SPR1xSS oa a Ovex ou 
BSLtOne . 2N1<5b2<SPR2xSS elroy — 2 Xx 

a 

NTAETAI<THETAIK(N] +PBE1 

NORE TAQ<THETAQKLNI+BE2 

A 

SA1<10NTHETAI 

CA1<20NTHETAI1 

Dace LONI GET A 2 


CA2<20NTHXETA?2 
D<e20(NTHETA1+NTHETA2 ) 


Q 
NZFIXC1i:NJ<NZi1; eee eee RE Soren ocean 
eee =(Y2KtNJxXS42xSA1))+D 


NZFIX([2: Ni<NZ 0D; ie 

aNOISETISNI<22 KCN] - XC13N 1 
aNOISEL2;Ni<Y re EN -NZFIX(2:N1 

a 'TRUE TCT X,Y POSIT MINUS NOISY X,Y POSIT? 
a NOISE[:N] 

a 

Q 

A 


mee en <I Zod +. X ARAL 
XHAT<XHAT+G+.xRESIDERR 

Q 

Q 

XHATSTORE<XHATSTORE ,XHAT 

A 

Reman olOneene ol DERRoOLORE ,RESIDERR 


A 
ADATAPOINTS<DATAPOINTS, NZ 
ADATAPOINTS<DATAPOINTS, 1010 4XHAT 


Q 
aDATAUSE<(2 tee ee 
aSUMX<+/DATAUSE[13] 

a SUMyes /DATAU SEED 2] 

aSUNA2<+/DATAUSEL 13] * 2 

en ee EPO caias J 
ADENOMINATOR<(NRPxSUMX2 )-SUMXx 

Bre ( CNEPX SURRY Jo SUNK SUMY> + DENOMINATOR 
aMDEC<R2Dx(01)+ 30M 

AMSAVE<MSAVE ,MDEG 

A 
VERRSTORE(13:NJ<VXC14N>TURN+14)-XHAT([2;] 
VERESTOREL2:NIJ<VYL14+N>ZTURN+1)-XHATOC43] 
PTRUE<(+4ZKxZK)x0.5 

RX<10104XHAT 

BHAT «(+P/REXPL XO. 


BNCPCERR 21 00% (sRPRUE) Reg ea hid AL 
RNGPCERRSTORE<RNGPCERRSTORE , RNGPCERR 
Q 


Q 
Q pUPDATED a 
Dae 


Bonen 2 1 19,XHAT(1 3 3] 
aeeen VECTOR: 
ERPSTOREL13;N1<ERR(13] 
ERSSTORE(2;N1<ERR(23] 
AERR 

A 


VEE EEA EEE IAEA EITM arr amar aoa omar ora aaron 

WWWWWWWWWWWWWWWWWWWWWWWWWWWWPDONMNNYDYNMNDNYNNDYNPNNNNDNNDNNNNNNAND 

NNNNNYNYNNEP PPP PRPPPPOOOOOO OOO OW WWWWW W110 WWW 00000 O00 00 O ~AI~WINIJ NINN 

NOUFWNPOWONMAOFEWONPOWONAGE WVOPOWONOAOEWNPOW ONIN FT WOOrROCWONDOFE WNP 

Ltt 
D D 


Q 
P<QOTER I. We pened 
A 


Q 

Ast PRE DTC LE Doe sa 
aP 

ind 


a 
XHAT<PHI+.xXHAT 
A 


A 
A 'PREDICTED XH#AT:! 
a XHAT 


aAX2<XHAT[23:] 
eXb<XHAT(uU3] 
aXt<Xu XH 4X2 ,X2,XU, XU ,X2,X2,X2.X2, Kee Oe ee 
NB axial ey ae ae ie 24, 7X4 ,X4,X2,K2, XO XU, XD ,X2 
aGTERMS<CAELXKAXXEXDIS*FS 
AC< 
a CALCULATE TERMS IN THE R MATRIX: 
Be ee eee eek ec 
SIG12<R1x(30A1#+22Dx1.96 )x2 
Boe (SHADE: 342 34 CXHAPLS J-Y2K(N] )x2 
STG22<R2x (30A2+R2DX1. 96 Yx2 
Q 
D1<Dx*2 
UL«( (SIG12xSA2x 2) (SIG22xCA1*2))sD4 
LR<«((SIG12xCA2%2 + (SIG22xSA1x2 
CROSS<-((SIG12xSA2xCA2 )+(SIG22xSA1xCA1))#D1 
Re? 2 5UL,CROSS ,CROSS LR 

(RP MATRIX:! 

R f 

KOKO OO kkk kkk kok kkk kk kkk kK I 
ITERATION NO. ',3(N+1) 


Ah ---- 
z= 
+ 


1 
<K+1)/LO0OP 


OR KOK Kk OK ook ook ok ook kkk kOe kok kok kok kok kook tok kk kk ok ok ok ok kk ok ok OK 


M<0.5X1+1<MAINLOOP 

GVSTORE<QGVSTORE oF OM] GYSTORE 

GSTORE<QGSTORE RE Sham 

VERRSTO E<QvERRST RE 

ERRSTORE< T 

RESIDERRS OPECORESIDE LOM] RESIDERRSTORE 
NGPCERRSTORE<(1 ” BNGPCBERS JHE E )oRNGPCERRSTOR 

ORNGPCERRSTORE< BiGecERRSTORE, tp ON GNGP CRSA STORE 

aMSAVE<(1,0MSAVE )oMSAVE 

AOMSAVE*ONSA AVE, Ean MSAVE 

MZLINLOOP«MAINLOOP 

ORL<RLSAVE 

> (MAINLQOPSO .5xpB6 )/TOP 

' COMPLETE. 
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